#ifndef __UDSF_DBSCAN_C_
#define __UDSF_DBSCAN_C_

#include "udf_global.h"
#include "udsf_cstdlike.c"
#include "udsf_spi.c"
#include "udsf_uart.c"
/*
*   notice:
*   UDSF 同UDF编程：不可调用cstd-lib,只可调用"sdk_ifs_udk_cfg.h"、"sys_api.h"中列出的API函数。
*   UDSF文件内函数均需使用static修饰符，且UDF中以#include "UDSF.c"形式引用
*/
static void udsf_calculatePoint_RXY(uint16_t d1Idx, uint8_t d3Idx, int32_t *r, int16_t *x, uint16_t *y) __attribute__((unused));

static void udsf_calculatePoint_RXY(uint16_t d1Idx, uint8_t d3Idx, int32_t *r, int16_t *x, uint16_t *y)
{
    int8_t sinAzim;
    int32_t frame_range;
	  sinAzim = d3Idx;
//    if (d3Idx > 31)
//        sinAzim = (d3Idx - 64);
//    else
//        sinAzim = d3Idx;

    frame_range = d1Idx;
    *r = frame_range;
    *x = frame_range * sinAzim / 32;
    if (*x > 500)
        *x = 500;
    if (*x < -500)
        *x = -500;
    *y = frame_range - frame_range * sinAzim / 32 * sinAzim / 32 / 2 -
         frame_range * sinAzim / 32 * sinAzim / 32 * sinAzim / 32 * sinAzim / 256;
}
#endif
